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ABSTRACT 



Thi£ ptapier diescrlbe^ a. pro-pased !qec^l9^ic^I iim c D>n.tra 1 .sy £ ten and 
SOmQ of ttie lines of thought which Ltd to this design. In particuliir*' 
the parser di£CU&;&a£ th« balic system requirBil in order Tor thi arm to 
controL lt£ dnviraimfliit^ «nd de-^I Hitti. ^rrpr situations which arise. In 

fldditiort th-E paper disous^e^ the system needed to control the motion of 
the ara using th.e coniput«'d torque drlvt ineLhod, and f&rce feendback. 
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"nie n. KT' A, I. Laboratory is ilt the process oT prodiUGing a small 
robot iMntpulation systemr the 'nini-robot' . The ovi^r^ll structure of 
ttii£ £^£tem is doninate'd by a division into thr«« pans: 

al A hljjh poHEr TEBote computer id^hicli 'thinks'- That Is, fh* 
CDDputer d«cidas an a course of action bised on thfr inforrnatinn 
available to it. - . • ' ". 

b) A Email loctil coffl^uter which centrals t vision ' syston. This 
system i* th% basic senior gf th« mini -robot, and is uiEd to tfAthfir 
:tiifortA&tlan about ttve environnent. This in form* t ion is then sent to the 
high Iftvel systtm, . -. ' ■ ■ ■ 

. c) A SDiall local convputer v^ilch controls a rvechanic-il arni. The 
arm is the mini-robot's output devlc«> and performs 'actions' ^ efrecting 
ctvansts in the onvirDfinent. Though it can also b« used as a sens? orjjan 
(Tor forces), its ebllltles in this regard are vsry prifllttlve. 

It shiould bfi streis^d tliat the high power ccHiputer probably will be 
physically renuoved froa the local computsrtf) . Furttier it is one of the 
basic design criteria that the bandwidi;]) needed to coianunicata bEttveen 
the tti»« computer sy£t«[ii^ b« 4S ^dall As pnssibi^. . ■ , 

This pap^r is concerned ulth the local aoTtware associated wit^ the 
mechanical am. This being the case, the high level and vision sj^stenvs 
are only mentioned in passing r' However, the reader shoulfl ke^p their 
t?(i$tanca in Hind , -." " ■ 

- Since the mechsnicil am is. baaically Just an output (Jtvice^ its 
control system alniifially could be very simple and devo-id of 
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'iDt^llLgervcs' n All of th« InlQlligencQ CDuld bB isr>LatQcl In ttie hlyh 
leval system. On the Qthir hand, a lot of Infornitivn iim;! int«lllf]-«ncG 
d^alin.^ with 'BctiDnS' Co-uld be placed ^n the am CDntrol system sd that 
the . high l&vel syst&m could opcratfr at a more symbolic lovel. This 1» 
the approach taken h^r^^. It is intended that thfr requests Tcr action by 
the high Isvel system will be concise orders Tor cemjjlate acticins IJ-ke 
"jjick up the ball", or "thrim the ballf^ 

The paper is organized d.s felloes: Section II first rnakei vscne 
' ifert&ral CQnunents about control ii^^ich Jnotl^'atfl the design decisions made 
lit th? rB£t af the pnpar. It theii; triss to indicate what the am 
contraller is capable of doing on its own. ^^ 

■■'■'' Section III jpicificilly states the beh&viour It was decided that 
fhe arn con trot ler shD'Uld eiihibit. 1% alsD attmnpt^ to explain why 
particular idtslgn decisions were nada. Finally, sceneries o^f four 
typical arts actions are given In order to ndkc the discussion more 
concrete. Electronic circuit beard con&tructian has been chosen ils a 
pro toty pile al task for the niniTobath and $11 of the examples in this 
paper are taken from this dantln. -. 

Sections IV-VI describe a proposed nschanlcal ara control system 
which eKhibitSi the required behaviour. Tliii: a the ^at of the pa|?er in 
that It'cantains the specific details gf the proposed sy^ten^. Hp^Bver 
the reasons behind the proposed system are vitally important as l*ell^ 
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-II. SOH£ IDEAS ON CONTROL ,•,-'" 

II. 1 ^ REGULATE * VS ^COWTROL' ' ._' 

In thlf p^per, 'regiila(«' mii ^cQirtroI' ara used in a spflcldl £ensQ 
to express twu ends af a spectrum of ths ds^ree of 'goodnass' af 
control. If A regulates B theci the control A has over B is io ctMnplflto 
absolute and iQnedlat;^ that it is not ttiougbt of as b&lno falliblB er a$ 
baltig a process, thouigh it probably is. If A regulntts B then B Is s«ld 
to ije 5 'direct effect" of Ar . '' ' , - - ; ' ■ 

.For ftsflflplftp e pArscn 'rcflulates' th* position of the thermostat in . 
e room. in cotitraEt» by iwans of this tharaoatat, he 'controls* tha 
l:eEBp«ratiir« of the rooa. Tftii is true even though the processes which 
alloM' a pQrfgn to regulati the position of the thermostat are inf4nitel,y 
Bore corapLex than the proctss which Allows the thermostat to control th& 
tenperetura. It Is not thfl complixity of tti* control profess, but its 
affeetiv^tieis titat is lap or tent htra. 

As A second axaEsple,. the thermostat mechanism rtatilotes the . 
position of a switch. This switch in turft regulates the on/off state of 
th# furnace. Finall^p thfl on/off state of the furnota effects ths 
tenperature (with e large time delay), Thr&uah this sequento of 
effects J the thermostat Is able to loosely control the tompirature* 
This illust rates the interesting phenomenon that" as you look intfl a 
control ine'Chanisin, the direct effects becomi- mori p-rijnitivg- and farther 
renoved from th^ goals of the mechaflisffip .' . . ..-/"■ 
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1 1. 2 'Cl&SERVA&LES* '■ \ 

For A tfl contrnl B, A must rflgwUte something which, through ^ 
chain of effects, eventually arrects B.. I'n additiori^ ujilesE A is the 
only factor affecting B, A must iJi able to observe B, or at least 
soaothtng related to B. .' , 

Hers AiSAin, the thc^nc^3tlt is a gocd eKAmirle. It Has destined nilh 
ttiQ rsalizAtlan that nany factors affict th6 temperature, and th«rcfc«ro 
wai (iesigoe4 to xneasure ttie tenpa'^AtLLrs. However, in Othei* Piirts of the 
^mntrsl latip the designers ivere not iCy isareful. They assumed that the 
on/off switch ha; canipLete control over the furnace and therEforo the 
thermostat w^s not designed tg monitor the furnace- Thus when the 
burner blo^s out, ar th4 oil runs out, a thsraastat looses ct^ntrol of 
the tecaperature 1 ' . •'- - -■-.'.-■ 

On a higher Level th« theroostat is only partially effective, 
because what a person really wants controlled! li fals confort, not t,li# 
temperature. His coaffrrt is only t'enuously related to the tempter a ture 
neoir hlju^ which, in turn, is only Jgo^ely related to'tl^e temperature 
naar the thernostat. The therproiiat ii only partially effective because 
it cannflt observe what a perscin really want& It to control^ It has to 
settle for soaethins only very indirectly reilated. 
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D tract Effocts -->b-*----> Obscrviibles 

(of A) (by ft) 

Ffg- 1 Schcnatlc oT a control snuat1«n. 



Thi thre^ Itay factors 'Of a contr«L situAtion art £h«wn In figure^ 
I* Th& rogrs tenuo-us the cliain of tff«ct£ which llcvt them, thfl w<;aker 
th$ centrel. 

•' ' ' '■ . ■ ■ ' 

11,3 THE HECHANICAL ARM ' : 

Let us consider th-a mechatticil arid CDsitro^ probl-aa in Che llgiht. of 
th« sbcNv-e ideas. Tli€ first thing t6 notice is thst th&rft ar& r€dlly two 
contr{>l problans^ 

. a) HtfH l£ the im a[>ins to ccintro], ttilhsfS ill Lt£ anvironnontT For 

•xampls how will tJia arm assesiblo a circuit board? ^ • ■ .' ' ■ 

■ b) How will ttve arm controlUr control the arm? For exampLs how 
will it ifliks the arm move fron point X to point VT 

li*3.1 AR« AS CONTROLLER ■- "- - •-■'■■ 

Looking at the first prottlej, it Is not usually thoucrht oT as a 
^control' problonir This ti b&cauie the connactiona In Flgr 1 are so 
tenuous. Firstly+ the direct effect* of the am are forces applied to 
objects in Its «nvlronnant and tTia motion of tKe arn thrcvgh the 
VTivironnent (possibly moving si3in«th.ing^. Tttoso affects hav« almast no 
bearing on the ^tate of completion of i. circuit board.- Only through a 
vory coifijiilfiic prot&duro can they' cause tha assembly of a circuit board. 
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S^-condly, th4 am can only abserve forces applied to ii, such d£ 
eont-act v^lth oth'Sr otjects, and iti aim position. Ttii^ [laes not en'iible 
tha arm te draw hardly any p nn-q lu5 i on s about Its cnvlroHincnt, In the 
prototype probl^q of circuit Jioard construction, ttie gBni>r4]I inability 
of the ara to observe its snviroimBiit i^ ovenH^iieKed tty th« great 
difficulty In observing tbe stdt« of completion of s circuit bc^rd by 
nny means. 

Wiat does "observe the state of cflmpletlon of a ctrcu.it beard"' 
msar? Clearly vision is. requireiji tO find OUt where illl -of the 

components and pttier bits and pieces on the work bench fl^e^ However 
this list of where each thing is is not a measura of the state of 
CAmpletiaii. There pmst ^Lso be 9 steteiiQnt of what a completed circuit 
board Is Ilka. From these tivo things, a list ef all tha difforonces 
between the absBrved circuit board, and a centpleted one can be created - 
1?ti& difference list seeaa to desicribe thB situation, but it i£ stLll 
SQnewhat uniatis-factcfy. ili?t only is it cunbijrseiins, it does not answer 
the i]iiestiDn "vih^t should be done neKt'. The order in uhich tbe 
components are assenihied Is often not ohvious but important. P&op>le 
constructing circuit boards usually follow an ax.pli[ilt procddurB which 
says wh.4t tc 4o wh«n, TJtsy gau^j-Q the stata of completiorL by hoii far 
they hava jottaci in thE proc«dure+ ■'- ..." . ' .- .'' 

■-, .- Wa see that ths closest ttiing tbere is to a measure of state of 
coDaplatioti is the point in the construction procadLire the builder has 
raached. Lnfortunately this ts net a very good laaasure. It ellotfs the 
buildef.to talk about and dsal uith th« statss of complEtion that the 
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prncediii'fl causB& the circuit board t& puss through. However, If the 
naruial cQurss of events ii dli^iurbBd and th^ circuit bD^ir^l is net in ane 
of th6 encpflCte-di states then this mcfisurB cannot ^ven dc.'icribB the 
iltuaticn let alone indicate MhAt should bt fione db«ut Ltr 

The grsftt strength of the thermostat on ths otb^r hand is that It 
ts praipared ta d^al (perhaps crudely) with any possible value of the 
teaperature. 

In order to bt Mntelligcnl' , the ninl-rQb&t hs a **hole must have 
ttl* 'Pbility to deal i^ith alriDst any eventualltyT It must have a 
da&cri}?tiDi^ good enough, to de&cribE alL situations, and bfr able to find 
a. way out of any trouble, Hawfjver, as discussed In section II below, 
the arm controllsr probably should not have this kind of power. To the 
IKtint that it is Ottly executing plans of action^ it cannot be said to 
be In control of its env ironme n t , because it is helpless except In very 
simple error situations. 

Lool;in9 at the individual steps in a circuit board construct L'On 
procedur-Sp things iooX niiich npre like a control problem. Take a 
relatively complex step like "niove the 4K resistor now at i»olnC A to 
point X'. Here, due to the greater inherent siDpHcity, the arm C^n 
Observe the relevant state of the world (i.e. arn position h Wo nattier 
V4hat happens, it can sinply continue to retluce the distance hetvfeen ttia 
hand and the resistor (If it is- not holding the- resistor) c»r between the 
hand and point X (if it is holding the resistor). It can deal with 
everything that can happen, because flot very nuch CAh happen: Note that 
if the arin drops ths reslstprt Insurinpun table problems arls«, Uithoui 
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vlilcn the arn cannot find th« resistor In raasen^l^la trim^, or b« siire 
it has found it and not the lOK resistor. ■ - 

It is Sttll aXBCutinfl a proEei3grt [^™VE_TO A) { PICi;_UI*) (ftm'E_TO 
X) (RELEASE)), and the position In tlhi£ Drocedurs l£ bein^ Uied as a 
measure.' Kt^wever ^ there Is 4 key differcEice. Ths procedure Is simpla, 
but aoTB Inp-ortantly, it is su^h that ^ny ftqite ?f the system can be 
described as d pc^lnt In th^ (paraB»teri??ii) procedure. Thus the 
COtttroller aluays kna'ws iMhat to ^c (i.a. rinLsh the^. prdcedLirflK 

TtilJ paper is sntltled 'A JIECHAMICAL AM CONTROL Sl'STEM'*. This Is 
really rather ainibigupui' Its neaning dopendi on i^tether ttie firm is seen 
as controller or controlled/ The dlscussi^in above centerSi on it$ ij$# as 
a controller, 'which is. the area of greitast Intar^at, {It shotild be 
tioted that the rest of this paper concentrates on control correspDndin^ 
to single steps in a jiroccdure, r&ther than on ^he high Leval control of 
the environDerit^ which is accoinplishedl through the production of 
appropriate procedures TroBV the singlfl step building blocks). Having 
said this, it nmst jtill bd i^ecc^gnized that the afm cannot ba A 
Controller if it is not oontroned^ 

■ . ■ • . • . : ' ... , " ' •"•.■' ' . 

■ ■ .. ^ .- . " ' 

II. 3. 2 CON TROLLING THE ARK /■ - T' •■;"■■"', ''. ".■ 

' , ' A Btchsnlsm which is trylnj to control the arm cnn rfi3ulist« the 
torque delivered by the mctors at the 9.rn*S jO'lntSr l^9t the mechiiniEin 
is trying to control Is the am's jiosition, velocity, and the force it 
exerts on external otjjects. F&rtyn&tely the control, mechanism can Horo 
or 1b£& directly observe the position anct force , nhich makos on& of the 
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linkj in Fig^ 1 very short. Unfortunately the notar- tortrufls, though 
runctionally rcLatod to the position etc ha'^B a vgry CDQiilex relation 
tp tnao. Thts ^akes it very hard (in the scnst of ma thematic ft lly 
GODplesL, net logically diffij^qlt) for a control necttftnlfn to calculate 
hew 'to chanija th'S torciues In OPd'Sf to counteract an Qbserved error. 

. It ±s ifiterasting to note that tlioro are mafvy ways the control 
problejns could, be slmpUfied b^ inprovlng tho direct errect» or 
□fasertrahles available to the controller. For applying a force with the 
unmovin? arm, the situation Is alre&dor optimal, Tha arm ccntrollQr 
Db&Qrves the force, and directly effects the torquei- For jH/Qtions of 
the Am, Che analogiouf optimal situation would be Tor the cohtroller to 
Dhservfl. both the position and tJie velocity and directly effect the 
acci&ler&tion .{insteaid oT the torques),. Notf -that if this was the only 
mode of control tt>4n th« control (MChanism yfould bs unable to control 
the Torca exarted by . the am on external obiects* Ideally the 
controllet' should b« abla to avitch betHresn thase two methods of 
control. Tha situation would be aliiKst as B^ood. If th& controller could 
bb««rv& the acceleration, because instead of usin^ Hugo aquations. It 
could takft advanta'Qa of the fact that the torqus at a Joint is 
jDotiotonloally related to the deceleration %.t that joint. Hoi««ravar It 
might still H&nt t'O it able to use the predictive po^er of the 
Q qu at i on 5 4 , .■ - " ■ ■ . : 
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III, THE BASIC CAPABILITIES OF THE APH COIVTROLLIR • V' 

I II. J KOU ' INTElliqENf &MOULB TEIE iUti^l CONTROL SYSTEM D£? 

Th& rirst qusstion to b« asked about th« urn ct^rttrol iystcni 1& how 
'Intelligent^ fihouldit b&T Tnt«;iio'ent Is a liard word %9 dsifine, in 
thl£ canCaxt thi question can be rsphrased as: hom cninplGx elfb the 
actions vihich tHa system Can reliably contrpl, despite the F^QSSlb 1 11 Cy 
of errors and unexpected events. , .■■ . ^ ■ 

Thus there are twe major kinds of ' intelligence' the system shoield 
have. First the sj/fstem should have knowledge of many tDmpleK -actions 
which can t)e initiated- with concise commands from the higher l^vel 
systa!!i&+ Thiis knE>Mledse can best be stored as procedurss, '> 

llii 'Dth«r type of 'Intelligence' deali ifith extraordinary 
situations. Hl3at should the system do ivhon sonethin'g joes wrong? More 
basically, ^at Is it possible for the system to (to biised on the 
InfornatiDn it receives and its abilities . The ara controller cannot 
deal with situations it cannot effect or cannct detect. Thus looking at 
the d,irect effects^ and the observablcs available to th* local systan 
indicates lipw nuch 'intelligence' is possible. , . 

Through Its direct erfect^p the am can movg an object to an ^ 
orbltrery pcint and orientation In its worltln^ voIubs, and then apply a ^ 
force. This should allow the arm to perfora tashs such as circuit hoard 

1^0 observables are a dirrerent matter. The arm's sense of touch 
does not give it irjuch information. It nust ■ loolt to tli& rest of the • 
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iainl~r4t}(it systan for nut^t of the k^y ififorniattoi^ it ne^d^- 



1 1 1.2 WHAT IN FORMAT I ON LlNCS SHOULD THERE BE 7 



HIGH LEVEL ROEOr SYSTEH 



Artfi iystERi 



C^ ) V1s1<5fl system 



I 




Ffg, £ 



Diagran of th-e CQmmu n i c*t i on links 1n the 
M1n1-Robot systtm, 5*lid Unas indicalg 
definite CDPnunicat iqn links, Dotted 

linES indicate pQ^^lblfl iddHtOHil Uniki. 



Ftg. Z stiDWS several passible inrormation llnfci t?ie artn system 
cculd have with otner eonpnnBnti of tJie mini -robot system ► Wtiich ones 
should &A ilipleDiBiJted? 

the ^ngif^er to ttiis question is donin4t«d by the Tact that since the 
una controller may be physically removad from the rest of the systen,- 
high 5pe«4 coDsnun lent ion na.y not hti pos£l.ble. Further^ the 
sinpliricatiort gained by rectucing the Ij^teraction with the rest of the 
aysteni Is -certainly deslrflbla, If the degra^^tiqn in the iirpa's abilitiBS 
is not too great. At any rate, all comnunicfltion with thi rest uf the 
systEon jhqyld be concls«r -■■■..'"■ . - ■ 

.With regard to the Info-rBatlon needed te' deal i^lth an error 
Sltu^tion^ errors seem to be divided into twp classes. The first class 
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might te t«rii!!*^ 'local' errors- These *re errors t^i^it ara reiidlly 
d«tectfld by the arm ilone |.«rror in position, etc.] and thnt c«n be 
corrected WlttlOUt rEgard to the rest of the environnent^ or the purpose 
of the ^CtiO'ri' A lineal error can. be correcte4 by Baking provisions In 

.. the control procedures. 

fi gond «xanple of a loc^l error is a drift In ppsition arising 

- during a notl-en of the arm fran point A to po-int B. Vfhile perforJTting 

. thfl motion the arm ha& wandered off nf it^ intended course » but It has 
not hit anythinQi, To correct tha error the controller nocd only plct a 
no** course to point 0. Dealing with driTt And stailAr problems is 
cl«arly a. minimal regTiirenant of the syste*, 

' Thfi niigre interisting clas;^ of errors, tfhich might te . ternte'^ 
^global' errors. Is typified by the foll&Hing, secnlntjly simpl&t 
exanpile. The am strikes tn obstacle. This error cannot b« flxed< 
without -Ppre global coEi^lder^tionSH ' The obstacle cannot be reinoved 
unless the Urn can determine that the obstacle is not n eroded t^here it 

■ ' i$. The am cannot ju&t go around it, because the obstacle may have 
t>e«n darrtagedr Tbe arm cannot even tell this without the visien system. 
If th& Cbstacle Wa$ daoaged, it must be fi^ced. 

In general IT the arm systen is frelng to be able to deal f^ith 
global errors, it oust he able to decide on a course i>f corrective 

"' . action based on the infomation available to it. It is clear that if 

the aria system Is going to ndlie intellijient cfecisionj^ to correct such 

' problees, &ven in the sliAjiylg case ahove^ It must have access t^ n 

C{>mii>lete aodel ef the environment, and to a model oT what the overall 
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iY^t^m ii Crying to ACtii^v^, in addltlDil It n^eds to b« abla tip use the 
vision systEui for itispection of thfl «nvir«nin«nt. .... 

. It is aIsd clear tliat the arm system cannot aaiHitHiin either of 
tliesB Eaodfils alone.. They reciulra Inputs taalnl^' Vrom thb- othar parts at 
the rcbot systoa. Thus v^ry high ^peed cDHMinication w&uld l>e needeit on 
all of the IJ-nfcs £USJ9«&t«d In Fig Z. _ 

-. Further, since at a higher level thsre must alreAd/ be a program 
CApablA ef such Intel lL!;;«rkC«, ivhy not use il? Why not tfike advimtage of 
the wi'die gulf "between the two error classes anil not iopleincnt s-ny of the 
dotted CDonuntc&tion llnki in Fig. Z 7 It was deoi^ed that th« qast 
Intelilsent thing the lecal Am system could do Mien it Encounters an 
unanticipated ^rror is to call for help, trying] to he specific about the 
error that happened, and abeut v/hat it i^as trying to dv at the tlnen and 
to request further instruction.;, frun above. 

III. 3 SOHE iXAHPlE ^CEUE^IQ^ • ' " 

In order to further clarify the abnvE issues/ scenarios of four 

typical artq actions are given .' For each scensrio ths ptp'sr indicates: 
IJ What information ii needed to Inltlata .thrl^ iction. 
-, Z) What additional InforHtioiL nU^t h'e developed by tbo arm 

CDhtrolXer in order to perform the action4 

3) Sonie of the looal errors the arm coj^tnollar can correct Itself. 
■4) Sdido of the error* it is not expected tn handle,, - 



I 
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in. 3.1 MOVE TO poiHT a 

' -. Thi£ fir&t act Ian is perhai^s th^ rEo^t basic 4r* notion. The arm is 
4t paint A, and It is asksd to nave along a ^noctT) p^th to paint B 
wittiDut tii.'l^ting anythifig. dnly pglnt B neods to ba specif i«i| In order 
to start the actloiip ITia arm. controller has to do t Int of workj ' 

a) [t hKi iq decide on an eJtact path from, A to & thnt the arm li 
capable of following Mithaut any high fflccaloratlan which would make the 
motion jerky. ■ • - - , ' ■ 

b) The system sl^ould also have soai basic idaas about objact 
avaii^^nce. For instance, IT A and Q ars both on th& tabl«, and fiT 
Apart ^ then tlie am controllar cauld plan a path that corrncs up ofT qT 
tha table in an arc, not a patti that skins av«r tho tabl«. Hers is a 
33 lacs that a nadel of Vhn 'envlronmant ^ould be vary usefult but how mucti 
modsl Is ftnough and .haw hard would it hb to Jteep accurate? The problerai 
c^n be avoided if the higher lival pragrans have a good inodel of tho- 
arm, and how tJie am controller plan« tra.Jectortes. if tha bighar lew&l 
concludes that a fnovE^TQ 8) commanci would cause the am to hit 
sofflfl thins then it just needs to break the move Inta two parts <MOVE._Tt] 
C) (HDyE_Tio Q.^ which avoid tha obstacle/ It ssents that tha staple 
heuristic of JiH)vLn.3 up itv skn arc on a notion will avoid nost collisions r 

Turning tq error situations, the m^in error the cantroller is 
sxpected to be ablfr to daal viHth is tha drift discussed above- In short 
unless the arm striked somtthlnfl, tha controller will gtt it to a one 
way'or another. Note ttiat If position B is tint a possible configurrttlon 
of the artrtp the tontroller will detect this through its inodal of the 
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actual arm* &tid CQH[>laln tn the tiighier Ivvsl^ 

ThB aUd ccntr&llfrr is not e^^p^ctetl ta hizindlc the; problem Qf 
striking sDiinethiTis on the way to B. In g&tieral Lt has io ap|9«al Co 
higher authortty In order t& determinE if the, srm ha* done ^n^ r|4nioge« 
It ecu Id hav« 4 criierj^vcv, such ttitii If a co LI is ion ¥h& soTt enough It 
would as5uinie that the cbjed vsi undandgedj and then try to avoid It and 
ccmtinue on as though nothing had happenBd ' » 

In thll CBSfr the COntroIlQr must be carofuL that it does not go 
-into aft in Finite jnotion iryijig cn avpid an object, A particularly 
patKalogical cas^ bccur^ ir point B i^ in jin object r 

III, 3. 2 PUSli A BLOCi; AST&E - ■ 

Here is another rither basic notion^ A block with dlriensions Is 
at position. A and the am is aiked to pusTi it a distAftce <) In direction 
R4. H^e requist mujt ipecify A, d^ R., and at least soiae infannaticn. 
\ aiiOUt D+ in order to start the action. 

The arm controller is flflinj td have to figure otiti - " ■- 

e,J How the hand is to approach the block. In general, it should' 
, be mnving along It towards the center of mass &f tKa blcck ^ point AJ with 
, the lonjg&it axii of the hand perpendicular to th* motion (so that the 
block will not rotate when contact Is made with the hand, and will move 
V in direction R) . . . -" "' - . -; ,_ . ..-.'.■ 

b] It ■ nuit also decide how nuch force to apply to the bloclt. 
Again the local errors the controller Cflu deal with are drirt-like. 
■ .B) "niare is drift in thi notions. 
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"lti)< In addilicTi several pr9l>lena can ^rlse which niro vory similar 
to drift. Fur instance if the block stlclis, the arm tries a little mure 
fdrcftj. if the blDclL s-kaE&s ilon^ it tries & little' less force. fsor^ 
inte-restins, if the bloclt slifje^ 9ff oT the h-ftnst, and looses contacHj 
then ths ^ru rruist bt^ck up t. little navQ lover acid try a^jain (as- lan^ ns 
the arm d^es net uo« e too far afield)^ The arm cpntroller can defil i^ith 
each Qf these prDtbletni by S^lmply doing tdtat It Mas dDin<3 before ii^ith 
aon» D&ranetcrs updated. 

The kind of global erritti the ContrDller cannot hancilc are t^plfifld 
by; . ■... -',.'• ■ ',. . - . . 

[ / aj Tlfifi ana hits something.. 

b) Th« l^lock hits sdm^ttiittg qnd itD'PS BO^vinti {ther« i£ a' sudden 
larg« rtss in force). . ' . , , v . 

'-'c!^ VJihen the am gets tc A It doe^ not find' any blocli, (the arra 
controLler oust b« careful not to push tho luirang thing). . - 

111.^.3 PUTTING A RESISTOR'S LEADS IMTO fi CIRCUIT BOARD 

This is a. much mure uonples *ttloT5. Let us assume that th& leads 
are already hent mid cut, Tht am is astt«d to pick up a resistor and 

ln»trt thfl tVO lai& into tha proper t>fD hales. 'Here the position (atid 

orientation) of the resistor j and the positions of Ch« holes need to be 
specified . •. '. r ■ ■ " " ■ • ■ i . -". ■ --, 

./Tills Is a tftsit refiuiring considerAbla precision of the artn system. 
First it Bust pick up' thare^lstar very accuri^tly so that it will have a 
re!asariatil& id«a. of th« position of the ends of the leads. Thsn it must 
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- " ' * - . ' 

move thfl and of ona le^d to iht rirst hols and insert it- Finally It 
must get the other lead tn the other Nolo, All throu'jli this the flrra 
controller nust d-acidi how fast tt nnven how Jiartl to push, 

Sooe of the errors th« arm can hAnctle in ctiii action arc so 
expected, they will probably alw.-ij^s haj^pon. In p4irtlculi^r, the qrm is 
probably not so precise that it cati Just put a. lead in 4 hole. liot^evE^r^ 
tho am should b« iible to git the le^d nenr tht hole. (tr it dees not, 
the lead iMy end UE^ In the ivrnng hole.) The nm must drflj th« lend over 
the board trying to find the hole. It should not do this for too long, 
alnc& t]i.e hale might be itiissjng, or plugged. In Cither cflso the cirm 
ioust ajX for holp from above. It cannot even telL uhat i^ent wrong: Is 
the hole nis.sing or did tbie am ni.is.5 It? '- ' 

■■'/' This ^hiolfl procedure could hi slapiified if the arm systov ^ould 
ask spflcific: questions of th* vision system (iuch &i: ""wherfl is the end 
of the lead?"} mid get a quick answer. This is the on^ place where it 
appears thit a small Increment in coomnicatlon could yield import iint 
gain^ In the power of ttie drn syst^iii. Tor most problems, total' 
cwnaunication. 1$ needed end partial cooffvnlcation is not helpful, 

Hflra are a cobiple of other errors the arm iyitetii could not handle 
without extensive communication: . - ' . '-- 

■ «J If the arm dropi the resistDr it is probably not aoing to be 
abl€ to find it. It might pick up the wro^g thing, 

■ ■■ b} ^ila trying to locate tJie holSf one of the laiids alght bend.- 
TTie ana systea probably would not even detect this, e^^cept through 
finding itself un&ble to ^et the Ibads in the board. - ^ -: 
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Thl^ points up th« important fact that whtl* trie nm ays t art is 
-working^ th€ rest Qf th« robot S^di^ Should be linking on, even If 
thBre is no (tiract raedbacki^ 5q thit tl can detect errors the arifi wan id 
nisSr Also th& aye mast check that things were don« correctly aft&r the 

arm Is finished. ... 

III. 3. 4 TICkKTENINCi A mi WITH A WREWCH . 

- . It la pa&ilhle that if the arq was Strong] eneugh tl wfluld not ffa&d 
to use a lyrencti to tighten a nut, bbt let us assuae it did need one. 
There is a wrench at location A, and A bolt flt location B with a nut 
already startsd and partly tlglttanBd with the h^Jid (this i^ another 
difficult t^skK The action Is a repeated cycle of puttiTig the vn^ench 
on th^ nut (this 15 the hard part), snlrtging the wrench thraugh an arc, 
and taking th& wrench off the nut, ■ The action stops Hhen the nut 1* 
tight. . ' ' ^ ■'. ' 

-." ' to start the action the requ&st mifit specify the pasiticn of the 
nut and bolt ahd of the wrench ► An interest in jf. vftrlitton would be for 
the request ttf spocify the siae of the nut^ and havt the ann controller 
remember whare the teg is are. This view looks at the tcols as part of 
the anfl* '■, ■ ". ; ■ 

Aj alvraVa the arm system must develop 3E>ecific trajettortes for all 
of the motions involved- Here are scm.e points of particular- interest- in 
this actiort: - - ' " . .,"" .' , ' ' ' " -. - -' ' ^■ 

fcj Vhin the arm picks up the wrench it Bust pick it up in a very 
precis 5 man-cier, so that it will know where the anct &f tha ivrench is. In 
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gBn^ral Che Arm $yft(>iq should hAvs a gand didiJqI af the arrr) urcnch 
Crnnhinatton, so that it can perforn tOikci lihs putting thie wrench er 
the nut aaslly* ■ ^ ■ ■ 

h) .The neKt EliTficult poli^t i£ pucting th& wrench dn the itut, 
Peei^la oft«n dfl this ivlEh twn h^nris. In ordar to do tt with one^ the 
arm tfill h&ve to bo iible to laccurateity rotat9 the mouth of ttve wrench 
about the ceniier af the hut» waiting Icr the wrsnch to ^iip on. 

A special tofll like a. snctet ■wrench or a nut drivtr wauLd simplify 
the .^'CenariO because the am wculd only h^vQ to put the wrdJIch on the 
nut once+ .. - ; , -■: ',■■■-■■..; ■■_' 

. cl Naxt force feecThaclt is used ie tifrhtan the nut -by swihotnj) the 
Mrancbi'. TBe Are the wreflcJi citi b^ swung througti t*ilL usually he 
constrfticved by otistacles, leaving a' pie sheipad region In which ' the 
virench can aperata. Thli region muJt be at laast 60 degraes in si2B for 
a typical wrench, end itiould. ha specified in the Iflitlal request. 

d) An Inlerastihg case nf Local *rror which arises ict this tusk Is 
when the wrecich pops off of th« nut. The em just puts it bact on and 
continues. " -' . ■- -■.',.■■ ' ..'. .''. 

. i). It is interesting to note that th!e arn ■dannot tall whether tt' 
was successfLiL in tightening a nut^ or whether the bolt Is crvss 
threaded, • ■.„.-.„'[ ■ ' ' •. . - 

in all these tasks, tha irm cnntroller can only correct local 
errors which do not interact with anything alse it is" trying ta do, 
unless the arm has access to- accurate nodels af what is going on, 
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IV. THE INTERWAL STRlCTlftE OF THE ARH CONTROLLER ' -- 

fiecclon II gave a ba^lc ltL«a qT what th« urn controller 1& ext>ectod 
to do. Ttie ntKt three sections HilL describe hc^ diBs? results can be 
Dbtain?*^- Te begin with let us sunntarUe ^hdt the inputs dnd outputs of 
the am hardw^rs are. '■ . ' ' 



fi.) IritJuts from arm Cflntroner (((irect effects of controlTerJ 
IJ Metnr torqucji (at a^ch Joint (6)) 
. £j Jflint lpq;kflri (pt each Joint (GU 
3) Hand contrfll inputs (open cIdsb) 
B) OutOut to controller {nb^ervfib 1es ] 
IJ IntErnal ^^n-sors 
; a) Joint po&itlons fat each joint (6)) ■/ 

. . ■ b) Joint velocities (mflybe) 

£) EJ(terna1 senscrs . ' - ■" 

a} Force seniors in -ijrfst . ' ■ '• 

b) Touch s*tv4ora on hand ' "--.■. 

. C) OuoutS to t^B BhvironmBnt (direct effects C^f Brii\) 

1} Motion throirgii onvlronm#nt - ' 

1} Forces applied to objects in tht .^nvirgninent 
D) Inputs fro^H envircnment (-axterndl sensation) 

1) Due to contact i^ith objects In the ertvircinment 
'- ' ■ ■ a) Force sensatipn _ ,' 

b ) To u c h 5 sji 5* t i n ' - - ■ 

FIq. 3 Input/output O^&cription of tht arn\ herclv^are 



IV. X ASV, ACV, AWD <J 

Uhat the aro controller is trying to corvtrol U tht output Ko the 

• - ! envlroniaent (see Fig^ ^h Dwe to th« decision to isolate tho arm 
. system^ the only vAy the controller h«£ of iDDciitoring this output i& 

through th« artii's otvn sensors (apart from seme positble hand-sye 

COOl'dinattan J* _ - ■ ■ --..■.'■:. 

■."■ Fortunately tho.flmi'.a sensors iro often aufricient for observing 
: ■ th« outputs to the environment. HoiveVBrf there is one Imnortant point 
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i^hlch cannot \ifS igncirSLl. That is the questian af slap antl in^tccuriicy in 
the urn. Tire arp cnqtrQlltr's ra&doL of tht arp &ia^ its abilities a 
only ^pprcxlmat^, and th& sinsors Ka^b limited accuracy. Ihis. l£ th^ 
major cab a* gf drift in th& ajr^'s octipfls. This drift C4n be correct^i], 
but only within certain limits. There is a deTlnlte unper limit to th? 
precision af control posslble+ 

Retijrciing ta the main dl£CU£si«n> Ai a iiDtdti«hal convonlencc, tlin 
AttN. STATE VECTOR (ASV) fgrme*^ rn^iniy of the senspr outputs from tho arn 
to the COCltr&ller (i-a^ the observablEs) is intrniluc&d, ■ 

. AiSV = (position, vElocityn force ^ touqti, hand, loclters ; time J • 
This vector contains all of tha inforttfctiAn that the arm controller has - 
about tht statt of the arni without getting additional irLrorDJition from 
the rest of the robot systeTn. The infomation in the ASV is dir&ctly as 
it cocie£ frod the £«n£er£. It i^ in the ^«n«r&lizecJ coorfSinates 
appropriate to the am (irOn the joint (ingles aniJ velotittoi). ■. 
= -Similarly the AfiH COltTSOl. VECTOft (ACV) wjiitn gfttl>er5 together the 
control inputs to the ara (i.e. the direct effects of the controller on 
l:h« armji is introduced, - ■• - . ■ - ;" . / : , 

ACV » (torquBSp Joint l&ckBr-Sj hand control^ tijfta) " . ' ,. ,-., 

Note tha.t these two vectors are not unrelated* - " . ■ . 
;.■ . . 'ASVCItdT) * F(A5V(T), ACV(T), ENfV(T)) ' -' '■ ,■ ■ 

That is,- the nsw state is a function cf the old statR, the cnntrol /. 
lnput£^ mid th? enviroiunent. Jp order to contrDl the Arm, the 
COhtrcLler attenpts an inversion of this reliitionK ... 

^ ; ACV(T) - C(ASV{T), ASV(T+dT), E*IV(T}) ■■ ' ■ - " 
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Unfortunately this lnv»rslcin can only \i% pertl&l far feevcral i'i3aaan*: 

aj As BfeEitiflfl&d Abo^^e, i;h* c&ntroLlB-r has very little k,nDwlctJg& of 
the envlrcnnent (EW£T)). Thorfrrore it c dh t inu^ 1 ly run^ the riilt of 
encountering unexpEcted dlfficuLtias. Each cpHpiancI to pGrfortn !in, action 
gives the minimal descriptign of the tnvirnnnEnt tji^t Is. necessary fpr 
the execution of tha bCtinii^ but n(^ PWrft, 

b) A less impartant problem 1& that G i« not single valued. Tha 
CDntrolIer must often chcose be-tween savaral way& of niulcino a Sitate 
transition, . . ' 

c) Horo unfortunataly, fr is not a tDtal function, Plany {in fact 
most) state trans it ions are not posilbLa at aLL. IntuitivEly this is 
clear because uttll4 the ASV has 1& in(^ependently varying ntajer 
compcNuents (6 positions, 6 vel uc i t i eij and 6 forcei), the ACV has cnly 6 
independently varj^infl major compM^nti [tha 6 tvrquesli Thus In genorsl 
the controller can only control i S-dliaanstonaL iubspace siT the A&V in 
one time interval* - . ' '. ■ " ' , 

d) Lastly, even Niten {j is computable, It can be canputed only 
.lU^proxiRiately du* to the areat mathematicoL complexity. This is another. 
major sauros of drift In the ara's actionSr 

. Stsppingi back a mojnervti consider that the Input to the controller 
from the rahot syitom Is a high level c^mjnaFid such as tflOVE_TO Ej, while 
tha JnpMt tfl the arm is stunraarijed in ACVfT)., This suggests a two Stage 
controller, with one stage that transforms the hlgti level cDimnand Into 
ASVtT+dt) ai;ci th« other that cDciputes ACV(.T) by Uting G. . -' ■ 
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IV. 2 TVIO STAGE CONTROLLER '. ' " . /./ 
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Flg^ -fl A -d 1a gran of the two stage arm controner 
showing, the Inforfnatton communicated 
between luals. 



The belUf that having a two stagE controller will ba very 
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convenie^it is bsi^fl on tlie folla■^i^;^^g fl.a£um|vtl5ns on the interdictions of 
th& two Stflfles depictEd ii« Fiflr 4, . " .' , 

a] First, i% is ilSSUiaed chat the procedural level nhJCh trJinsfDnrtS 
« high level ccwiunand into i series af atAtcs of the im dens ncyt ned-d to 
itnsw how tti-e state transiticns can be rtali^ed, 

b) Seq^fld, it is asEUQEd that whin the tiynanic level ia ^valuatlnrj' 
fi» in order t& calculate htjif to get from sttte A to £tAt« B, it daea not 
ne«d to know >ihy tha p roc a dura I level wants to Hike the sttit6 transit iorr 
or where thfl arm iii going naxt. . , '"..".'■' 

It seems that iJi ganaral ttiese as^umptians are valid, There are 
jQVeral clear advantages to the tiva stage design. . , 

a] ThB Cpuvputation of (i Is Vtry CCnU^I&it, and elaboratB 
approxtsaattdrts must hs usedr Thus it ts very luportant to isolate the 
calculation of ^ in ona place whers it can be done wii]i the greatest 
possible efficiency- - ' " 

b) Till division also Rakes the system cl^artr end. sore tractable + 
Th& dynaniic lavel can bp locked at as an MUUlitbr which mafcas the' arm 
hardware look like It takss desirad A^Vs as Inputs instead of ACVs + 
Thus from th« point of viaw of tke procedural levii^ the dlrett effects 
have lioart lEnproved. It never has to deal with the complex rajithematlcs 

.in Oi Nor d&es it avar have to deal with the jjaneralized arm 
coordinates. It eiin work in coordinates suiteti to the action, not the 
arax -■.'.■■.■' 

c3 Another ioportant point involves the MnteLlig&nce ' of the 
BllniTObot As a. vrhole. In order to ^tlClderstand' what it is doing+ it 
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HiUJt hav« SDITie way qF iUucidAtina ths InnBr structure af its actlQii^' 
But hm f-ar shnuld this decprnpositicn ba all^u-ed to pm^rcsa? 

With th« two 'itiaiBfi conirollQr, the an^v^er is. cXear. Th« dynnQlc 
level opa rates ai a bl«ck boK, tJ^-a conjplgx nwithemfltlcfll knowlodgc m it 
fdr&v^r hidden from the i-eit of the ^yst^q- The proctUurfvI level on tho 
□ ther hand has all oT iti kiiii^jled[je syiTiJjQlicjilly rei^rcscntcd in 
pro€ocl.u.re5 which are composed of numed priBitive procadurss. 

Thus th« BlnlTobct can Intro^p^ct dovni to tli& level of these 
prlmitiva procEduresi and nQ f&rther, Thli clo£«ly pflCAllflls the Kuman 
situation. A [>er£cn can introspsct about his nvotions down to a certairt 
lev&l, but no farther, for ejtajnplBf most people think of wiggiinB their 
ears as a prioltive action (even thcugti it is prcd-uceJ by the ccnbineij 
action of many rau^clfli), beciiu&» they are p^oK-arless te control these 
muscles. bcLoif & certain level. Tlpst people c^in wiggle hoth eor&i hut 
var;y feiw can tfiggle Just one> evM tho^gti thers «re seperate Qroups of 
mujclfs &n each side. Tliis is because ttiey cannot cte compos a the action*. 
They have no 'names' for its constituents. Ha way to ^et a Jiolct on 
theiiL. • " • ' . . - ■ 

<i) f\ final point is that' s^cne time in the future, the entire 
dynamic level could be inplemerted in hardwara, ihcreastnjf its speed by 
Ewitching to analos aatliods of computing ■G/., ■ 
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THE DVNAMIC LEVEL OF THE ARH COJJTROL SVSTES1 



A) Output* tfl til a arm hardware .' - 

1) ACVtT) fhE control Inputs • - ' 

8) Inputs fron, the nirm h^rdwa^ft • • . 

ij ASy(T) the currftnt State of. the am 

C) Inputs frpn tiie pi'eccijuriil level 

i) Th« <le£lfQd ASV (Di^^V) at t;^« n«}<t; tltne Intflrval 
DASVn+dT) ■ ■ .. . ■ 

D) Outputs tg the procedural leveT 

1) ASV(TJ 

£J DELTA(T) this is a condse stfltom&nt of tJie 

. difference bettJCOn ASV(T) and D/^5V(T). It is 

expected that tHOi' will not ba tha sana becniu'ie the 

■ dj^n^nlc 1 aval's eVJlluatian of fi is d-rll/ appraKinata, 

and It has aliMSt no kncwledije nf ENV(T), 

3J yhen an grrgr goEnJitifln arises 

a) Tha procadural level ts interrupted anJ • ■ 

b) Passed a condsa description of tlie error. 
(Note that this exactly parallels the 

.Intaractionof. the arm control ler as a who He 
With the rest of the mtFit-robst systcn,) 

Ftg. i Input/Output daacrSptic^i af the E^nafnic levsl,.,. 



V,l THE DASV ASTDCOHITRDL STRATEGIES . " . ■ .. 

M meTitioned above', tha dyn&ulc level eatirtot cAntrol all af the 
vari&blfts ifi the ASV at oitDB, In recognition of this, the format of. 
DASV(T^ ts designed so tttAt the procadufflL level can Indicate which 
cmiiponanls of the ASV it U r&ally interosted iti controlling. Tha DASV 
iias th« sane- coapohentA :ls, the AS.V, but gach on« can be cither^ . ^ . 

a) A specific number, which indicates that this ctinponent is to be 
expliqitly controlled. . ; ' . " ' - 

b) A list (NoniNALJ/ALUE, ■ RANCiE), which indicates tliftt an error 
should be sisnaled If tht ' component gats outsida of the intervnl 
fNQHIHAL VALUI +- RAMCiE}. ■ '■ ■ . ' ' "■ /' 
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c3 NIL, ttili indicates that tht proce<3urfll LqvoI Is n&t concdrnsd 

I 

witK the valuB of this cdnponftnt, ■ ■ . • ' 

Based QH the form (jf lb* DAS-V, tha dynamic level use* nfUS oT the 
follqwins bAJilc s.tratefli'ds to conpute iQ, 

a} IF the DflSV indicates that position and/or vElocity Is to be 
C9ntrtill«^p th&n the e^uatipq; gf motion for the aru (scluEiny an 
approximation to- them) are used to ccMnpute the AcV. 

bj If the CASV indicates thaE force Is to bfl control lad, then 
[^ir^ct fe^t^back is. used to control Lt. Haw the mot^r 3:qrqt(«5 effect the 
farces' sensed must also be qalcplatcd, Thti depends on the flrm position 
and tha point of contact. 

c) If 1«S5 than a 6 dlmensicnal S9t of ccqnponents is specified for 
eantrol (in particiilar if none are specified), then iho flstra freedom of 
ishcirice for ACV(T) is used to iteep conponcnts of DA5V(TJ spactflBd as 
intervals closer to their nominal valuo£. An exaiajiie of this is in 
push in j7 a block aside. The EJASVs have no sp&cific tcmpnTients. BeFor^ 
the hand touches the biock, it moves at th© nominal velocity r After 
contact. If tha force rises abnvg the nominal value, than tha velocity 
ulll drop. .,,"■. ^ . 

d} The preceding was an exanple of & situation whera contol 
strategies &) ani b) had to t>e mi»ft(i. This is done hy ^prlylnQ' both, 
and using the ^Xtra freedam of tholce in each one to mate the two 
solutions fitr For example if ^ positions lyare specified than, this 
wvuld fill 4 ioints. if in addition 2 forces ware specified » then th^ Z 
reiaaining joints ivouLd have to Ij* used to craata the forces. tf this 



.ARM COJJTUOL SV&TtN PAGE Z& 

C0U,14 rtOt bff dtrns^ the dynaujc l^vel wquIcI cgBpl,ain4 

'. i] Note that n(j attespt 1& nacle to control ttie touchi .■>f;rT5al.iDnsH 
Their state depends oei tWVtT) wlilcti Is unknown to thli level. Ttiere is 
no VAy th^t th« senaorA e&tt be [aAd« te tui^n on in a fhcrt time dT. The 
dynamic Iwel ' jtt£t reports their value, and can be set ta cause an 
interrupt when they chanoe ^tate^ 

f) At the opposite e:(trene, the dynamic Level repulntas the 3tAte 
Of X-h-^ Jctint loclKerA and hand. Thus an «rr«r in th«SD is n^ver 
detected, ■ ^ ' . ■ ^ 

: V.2 the' BASIC ALGORITHK' OF THE DVMAJIK LEVEL ' 

The- 4yn,afflic level Is activated at a distrete set of times Ti, in 
order to produce i. step function ApprDXltnAtlom ACV(Ti> to tbe nctual 
ACV(T) which would produce the deiirKl act ion r The Ti are Epecifiedi in 
the tiue coMpenent of the CiA^s. ThB ci«£ef tofiettie^r they are, tlie 
better the a p p rax ima t icn is. Nom good an appraxiinatiDn is nes-dod 
depends on the preciji«n of the action,. 

■ At each time interval the ct}ntaml.c level executes the following 
alfforitlriB; ■'■.•■ 

■- 1} Obtain A£V(T1J from the arm sensors. :. ' :-- 

■■-.. Z) . Compute DELTAJTi) froo ASV(TiJ and DASVCTi) as follows;/ • 
I , -■_ ■ for esch fllenent of DACT(Ti) one of thr&e cases "applies ^ 
'«J coBponcnt afisant. D£LTA(Ti) = A5V(TiJ 
■ . . bj .conpanent an intervflilH DELTAfTt)' b AS^'fTl]' - 

■"- - . ^ ■ (WOHINAL VALlJt{DASV(Tin)-. In addition, if ASV(Ti) is 



i- 
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pytJij4e cf the 4l lowed intarval then Interrupt the 
■ proc«<lurnl Isv^l And infonn it of tha arror. 
cj- coaprniEut 9 numijer,. DELTAS FlJ = A&VCTl) - CASVtTi) 
. . (nfltE that the prohafetl 1 ity Is near icro that 
D£iTA{Tl} = 0, «ven though ttklt l£ tha poal. H&uflver, 
tha dynamic laval tatas nq action here ng matter what 
DELTAdi) Is. lt«tllL6r it uaLts until step 4). That 
''."'- ■ is, na jnattfrr hav bad it did last intei^val, it vill yo 
on if it thinks that it can set to whoro it should he 
at the. next timo interval. In any case, it can us.6 
DELTA(Ti] to infras^a lt£ ApprDximAticn to Ci.^ 
3} $it BA£V(Ti+l). Th» prDcettunl lev^l cDnununicqite; with 
the dynaimic level througli a srutue of M^Vs, If ttiif queu^ 
i$ ^mpty^ tha dynaoic levaj interrupts tha procedural LfiVdl 
41)4 requests a 1>ASV. Tho am oust h« continually 
Cfmtrollad. Until' the dynamic level gats i DA^V It will 
continue tht current ACV 'with po^^ibly bad results r 
' -' HOH clD&a- tha CouplinQ between the tvn Levels i£ 
depends on the length of thi queue. TllO pr«ce<lural level 
' cdn taka complete control by supply' itigi th« OhSVi «fia< at a 
tlna. Alternately tha prDgadural level can leave the : 
dynamip level alone Indefinitely by putting a Loop in the 
queue. . ." '■ . 

4) Calculate ACVCTiJand SPPly it tfl th* 9rn, ■ To de this, 
the dynamic level [iiust first Check to see that DAiV(Ti+lJ 
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is ac h i-ev ab 1 e , ir no^ ^ it interrupts th'C proccilural level 

and requests a n^vr DA^V(Tl) uhlch is achlavnblSr Ali^o not« 

■^..' that sane suljconput-atlons (such as avaluition of- the 

flgudtitin; pf mption) an very tine consuning and i^i.!! h^ve 

to be spread ovtr savsrAl time itit&rvals, - . , . 

^ ' ' 5) Wait until Ti*l and then gfl to 1), It Is very important 

tKat the dyn^nlc level begin It* computations at tins Tl+lj 

it cannot i«JltLt far an^'thlng. ALstt tbie entit^a COmpatatlon 

. ' - . must be Abort comtiarecl v^lth tho length of the time 

Intervali er the contral will dEtBricrate. To this dild» It ' 
' ■ \_ i£ Clear that th4 arm aystem as a whola will have to run as 

a set of asynchronous %ii}i5 sharing th« CPU tiirvs/i 

V.i ERROR DETECTION IM THl UYMAHIC LEVEL .'' 

Let,u5 take a final loolc at the 'error detettiotv^ the dynEunic level 
ii doin^r It is of two types: , 

' -. -' ' a) The dynamic IfiVel coiDplains bBCdu£d it canni3t makfl A requested 
state transition (step A')r The problen coultl have been caused hy qns cf 
two things: . . -..-■.. 

' ' - 1) An impossible sequBnce af DiA&Vs v<as issued. TtiiS AtlOUld 

not occur if the proceduril Level has & Qood ancugh model oC the arm's 
abilities.' ■^'- ....... .' • ■- .- '. ,. 

Z] Inaccuracies in the computation of (^ an4 in the aria 
hardware caused the dyn&mlc lnvel to wander too far (r<m the r« (rues ted' 
trajQctorv for it to reeover. . . ■. 
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' " ■ b) Tha dynanic level c-onpUined because some slcmi^ni: of DASV(Tt) 
{«?cpr6£sed ^V a rsngt) w&s not consistent i^lth ASV(Ti). I!s£«ntlally 
- thbse- rafi^Q elements in tne DASV - are used to nold prcdirtitms of tho 
corraApondirrg ^leufrnts in ttifr A&V. Tht ii^naiftic l«iy«iL siriply irvrorms th« 
lircicedural l«vel whenever the prace^^urfll IavaI's predict Irin 1^ 
incorrBGt. (This tiaiic methpd of error detection was used hy Ernstl. 

£lnc& the dj'nADilc l«v#L Itnov's nething iDout the 'i^Hrposf?^ e^T Its 
actianst of ^out £HV(T], It really dim n.ot know whtit 15 li^ppenin^. It 
kno-H5 that situations oT typi "a" (abov«) aro errors. Kpwevfir, it do«s 
not know whit Che 'meaning' of a typg "^b" situation is. Th-c Interrupt 
"• Bfichantsm ii Juit us^d so that the prgcedttraX levfit cm; r-^rru^st the 
dynamic I'CveL to tiring \Ley paints at infardkation to thg atlcntiign' of the 
procedural lavsl, Ttift procedural levaL must decide what the information 
'Beans' . ' 

For example th? inrornution that a tauch sensor bias chancj'Bd 5t^t& 

could mean ''the hand Just crashed Into tbc tdl>le" or It cculd mean "the 

' liand Ju^t found the capacltar'. it all depetiJ^ on i^ihat Is being done. 

■ ' . . The ail ova oachanism Is probflbly not Sufficient for all error 

, ' ■ detect ion.' In addition thara will probably b« 'dtPOris^ tn the 

procBdural level that Jlionitor mars complax functions of the A^V or other 

• r ■ 

indicators in order to detect error ^ituaticns. Tlie interrupt mechanisn 

nerftly Institutionalize! the mo&t conunon Itlnd of oonitarin^. 

Also on^ ^leuent is add'ed. to tbe p^gV not found in tiie hSV, ITii^ 
element almply caus^^s an interrupt whenever It is present. Thi* is u*«d 

' - to synchronise th^ actions of the dynamic and procedural levels. In 
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parttcular It would b« u^ad to inforn th« prncfduritl Uval thAt a 
pariiCLilAr phase of on action was comthletcd. 

■ iBi siMmary tbtci, tht dynamic lev^l l* lean to be (lujtc simple, 

eTfcept for the nithemafical eonpleKity needtd to carry out the control 
(I.e. -coirvDuting C), 
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VI. THE PROCECUEAL LEVEL OF THE AR.H COJJTRCiL SVSTELH 



A) Output to tht dynaalc Ifrval 

IJ ^I'^SVt ri) tha d6slrBd A5V ( cammunlcaled thrr>ugh a 

& 3 In pu t s f r on t h e dy n am i t 1 e V e T 

1) AS^di) the eurrcftt stjl.s ef th* arm 
.^ i) DELtA^Tf) tliB summary qT diff^r^nc^^ b^tv^&^n 

ASV(Ti) frnj OftSUtTI) . " 

3) InterruE^tJ slgnnlUna arror* land kej^ fr>rcrmdtien 
datailftd In DELTA(ri) 
C] Inputs rrdm thA ht^h l^vel rnbDt system 

I) High level commrinds in the form qT \,15^ prnprtEimis 
2 J Interritpt* signalling irror conditions or key 
fnfiQirmAtiOfV debacted by Othtr elgngnt^ af the 
miFviTobot iyitflfl (for exawpla the vision systce*) 
C} Outputs to the high IsvbI robot system ' ' 

1) SignaH indicating th« completion of tin action 
'£) ASV{Ti) [In soma' hi^h leval cottniitinttn) ^f 

requested 
ij) Interrupts siflnallirio error situations . ., 

V . .■4) A dascriptlon of iny error (sea V.3 belcwj 

Fig. 5 Ihput/nutput descript ian of tha pracedural level 



VIA THE PROCEDIXRAL LEVEL IS A LISP SVSTEN - ... 

' Tht procAdurtl Iftvfrl is a Lt£P system Kith a larg« ho^y of built-in 

functions. TCiesa functian^ can b^ divided into thrSe classes: ' . '' 

a) Tlie rirst class consists of the basic Lt5P functions (TflOC, 
LAMBDA, COMD+ etc) pLus a set qf functions to Implement the nuultiplia 
asynchrpfipus control paths necessitated by th* real-tine dcmninds on tho 
s^steiOn Th«s« include functions for s^chronizln^ cotTtaunication 
between, creating, and deletitigi control paths. - . . ' 

In -ftdditiOEl there are function^ fgr qreating and Tieldlnf 
interrupts (s»e Vr3 ijelow). ' '■ /' . " ' 

b) , Thi Stcond frroup of functions embody mathematical InrDrmation 
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flboyt tha ars And its cApaljilitiBS, These tnclyde functions for 
transfortfling between t-oiirtjinate systems, plannin? tr.-ijRctorlesp etc. 
Tlia dynamic level can lia thouijut or as one dT thess progrrims. Tficic 
progriims ore Implemejited in Ruchint code for a-fficiajicy. 

' cj The lA5t cl^ss Is the mo it Interostltig. It is the s<3t' vf 
lirDCBdur&£ for perf arming actions ^ TlicAe progrriins iire fecpt as lists ^ 
and ara avallabl« for Inspection b^y the tilohfrr lerveti. The conKniinds 
SQDt b/ tha hijjh Ifrvi^l system, ure either direct Calls on th&A& 
procedureSr 9^ DDre complex prDceclurcs built E>|it gf th? FrlnCtiDns 
already In tbie system, Pracfrduras can Ijb ddded, deLetad or Altc^rod by 
t}ie higher level gy^teni la order to suit its needs. Some es^omDles of 
bAsic orocedurea ire; ■" 

1> ITOV£_TO B. . . 

; £) HALT arm whfjre it is* ^. " ' ' , ." '■ . 

■ 3J APPLY_rDHCE F tO point A. ■ '. 

^) H0VE_lN_&IllECTIOil R. frera point A' until contact is made ^<ith an 
object, then hilt. 

fi) GRASP the object between the hand's flngerji iioms reutin^ 
called by thl^ rthutine must calculate the ^Kaage in the inertlal. 
description of tha arm when It picks up the object). 

.; Some exampies of more conplex procedMre* that nis^t he in the 
system if It were wprfclng in . the anvironment of circuit bnard 
construction ara: ■ ■' - . "■ . 

- ■. 'ij IK5ERT_RES1ST0R at A In holas at B. ' -. 

2} START >JUT at A on bolt at B.' 
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■ 3) SOLDER^LEAC in hoU it A. 

'. ' i) ATTACH_TEST_PROBE to lead At A. ,. . 

Any action c^n b«. encoded as a pracidura as lonsi as it uan proceed 
by dead reckoninsj Miiihciut reedbciclc frtm thfi fCSt of the syF^tHJl- Vhettisr 
pro^eettiipai like 1-4 ahove wUl be n3©ti& *flth or v^ithout visiinl feeObscl? 
dej)8nds< on tha tfl£t4 of th^ us^rs^ and tlia spei^d gf vIslihI process Ih^f. 

VT.2 HAMDLIMiG E&ROR SlTUAnONS 

It Is clear how everything worJts as long as no errors artso. 
Ho^ever^ It Is the error sitm.tians. that are the dost Intsrestlnf, 

.' InrDrmatlDli alioiit errars a brought tii tti? attentimn of procQduros 
able to doal with tti»ni ttir»ugh Interrupts Issu&d by other procedure^ 
which have gotten into truuble- Thi interrupt- facility is basically n 
simple pa Cterfv -directed Invocation racllity with two kty differencfls. 

4) It Is 4S&iunjed that only one procedure <nil'L be apprdpriAte at a ' 
tlm&. .This aj^suaptien Atiis. not se^tfi LLnrBas^indble in ligiKt of Che siinple 7 
kinds o^f errors with which the ara control sysCfin is trying to deal, » ' 

. , b) Contro-l Is i!ili;;kost n«vfrr returned to th« routine issuing the 
Interrupt. The issuer is usually supplantai] by an updidtecl iTrr roach to 
the problain facing the am control, syst^g. 

.• Tbe interrupt nechanisn is imp^lenent&d. by two functions; 
"a) (SIGMAL IMT A&UE&_iNFC'RnAnON) Whara IHT it an atom fthe . 
pattern for pattem-directad Invacation.). ■ and ADDED_INFORnATIO.^J is 
anything that the slgn&llar reels v^ill be useful tn tbe invoked 
pr4Cfldijr&. . ■.,'■, ' ' .. .. ' ■ 
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■'. b} {ON \aT PREP' ACTCON) V:ncn an (»J is oSiec^titfld, it Qhlar^ thfr 
triple (INT PR£D ACT30JJJ fln §. stfick. Tfts triple is reinflveJ from the 
itack when the PROG the ON Wiii exicuted in U exited. 

Utien an Interrupt ii slgnall«dp th4 stack is s»Arc]i«^(] for an 
api^ropri^te trijtl^. A triple is apprpprlito If INT is thu ^{imc as the 
on» slsAallBdp and E^RLb Is Irue. Wlien ah apprDpriatt triiilc is fciuntl^ 
ACTlpKJ Is «v£luattd In the unvlronnsnt of tha PROG in hrhich the ON mni 
executed. - 

Hare is a finple CK^nnple qT an -action procedure using tkie$e idn^.^i. 

' {DEFlffl ROVE_TO CE) ' . . / 

fpROG u : ■ ■ : 

. .'■ ^ ■ ■': (DW COHPUTION T (RETURN)) ' . ' ■. . 

_;. ■ ■■ (ON UNAfiU_TO_CWJtlNUE_noTlON T (60 R£TRV)J ■. 

■ RETJIV (SET<] DA5VQ (rtA]iE_TRAJECTOKT B)) ' ' . 

:.:..'• ■ . (sysPEMDj )) ■ ■ '•'•..'. 

Is the ^Qve^ DA5VQ i£ the queue of DiA^Vs used to corwicLnicate with 
the dynamic l»veLr COMPLETION Is tha interruft that la sj^iaarated by the 
additional alem'snt of the last DASV in the guBiie. 
UNABLE_TO_C01iTINUE_HOTIOK is the interrupt signelled by step 4^ of the 
algoritjira running in thi dynaalc Level. ' MAK£_TttA0ECTORY is a 
aathenflticfll ►'outina that pl^ns. a trajectory froi» the present location 
to tho jujint B. Th? raturned queue of DASVs is terralnatect by one set to 
signal CQHPLETTO^J, find one that points to LtselT to- keep the arm 
stfitlonEiry and waiting at pojnt S. SUSPEND ij a function thnt stops 
cxacution In a control i^Ath. E>:ecutiDn c^n be resMnrcd ify thr? action ttf 
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another coMrol path. , 

Th« structure dT this progran is typical. t\ procailurnf uti-Hnlly sota 

up a series df alternjiti^BS for futurih action r CO[nputf!s sorae number oT 
EJASVsp And tl^^n £us pencil it5«lf. It will liit«r && ra^xcltf^d by an 
interrupt frcu the dynaniE "iBvel. ,_.,.,"' ;^:,-' ' , . .. 

V,3 A DEEPER LOOt AT ERROR SlTSJATIOtlS 

.Tha lnt:«rruj3t facility Is Inte-nded to'glvft ttie procedural level the 
ability tg deal with simple IcjCal errors, l-tidt 1& the crrDrs 'd&SCrilltQd 
in Section II us beins easy enou^la for the arm control systen tc deal 
with a Ion E. .'••."■ ", ■ - > 

But what atout difficult errors? How ar* they d&tected and what 
dsts th€ procEdural lev«l dd about tlient tita only way the procedural 
level has of observing errors li throutrh the ASV, As long a^ it 
contains '^^Ivas cdnsistsiit ntth there beins np errprs, thaA no error can 
be detected by th-e procedural level. As soon as the ASV fnil^ to agro^ 
with ths prediction of the procedural level lor a watching demon se-es 
something »frong) an interrupt Is Issued, At thlstlm*, the ON stack is 
searched for an ApprorUte triple r If onfl Is found n flTie, If one ia 
not foiuind, thisn the jsroce^ur^l level concludes that Xi cAnndt deal with 
the error. At this ]9ointj tha ?ii^h Le^el system is interruptefi, ALsq 
since it may be a Icns tjpie before tht 'high level syatein responds., the 
arn Is told to halt where it is, and the whole &rn control system waits 
for * ccmmanel from tJie high level system, _.■. : ." 

. Note that tJi& interrupt might not have »ri£)inatod in the am 
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cpntral systEE], but rather In ^ane oth*r cort^onant of tha iflJnl-roLioC 
systf^in. for Instanco, fha vl&i^>l] s>'^tnni njight hava: dcLcctcd sonclhing 
f^hic^h it wl5^led tQ repgrt directly tc the am C[>nLroller rathar than to 
th9 high lev^l system. If th« am controLl&r d&e-£ not knokr whdt to do 
ab<^Lit It^i it will Just reflect the interrupt Upi to the high level 

In suoaary^ frmn. tJ^g ppint gf view of ttie procedural level ► a. 
difficult errar is an interrupt fgr Hhicti no speciTic ON ha& been 
ft»Qcutc4, Uhonev^r 3 difficult error occurs, ttifr procadural level askt 
for help and waits. ■ '■.■■'.■■ ■ • ■'. 

. NoH thi Inipcrtint question is: 4iow is- the high lev«l system is 
igicin^ to rds|>and ta ah arror interrup^t? There are K^o Dtiin ways for it 
to proceed. . . -v , 

a} Xh6 clean glate approach: Here the high level system decides 
Adt tg try and salvage anything of the curront &tat« of th« am control 
system. Rather it jti^t loots With visign «tc.) at the current st^t* of 
the envlroninont, &nd on thfr iynl^ af high IavbI goali create:^ an 
entirely nput pracediirA tQ $ie:nd to t^ie aro gontrol system, in urdar 
COrraCt thE error and continue on, 
-• ■■■. b) The pfltch up approachi Here the hl&h level iystem tries to 
patch up the partially oxecuted procedures in the arm controller in 
prdgr to Correct the crr«r, and then ha.^ then continue on, ' This has the 
odv&ntasjo that [partial -coapu tat ions are not losti Also there is a good 
chance that similar patches can be given to similar errors even when 
they occur in the contQ>:t of very different actions. Tlit bi[fgeit 
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disadvantage' of thi£ apjiraoch i& that tik^ higti level i^y^triiri maj.^C know a 
are^t deal of information about the {Lim contrd system in gcnnral, and 
about thft ipecific cDntrol piiths currently bfilng exocyteJ^ in order to 
itake a 8°-od patch r- 

Also [tota that the S^cAnd approacti Is net able to do fiiiiyttllng that 
(jannot l>e done witli th« first netlaod, The seccnd nethod is just noro 
COnveni'SJlt^ Further, ths ^ain is greatest if the nn^faing proC;aS£ Is 
ccDplcx:. If It is simpls then thi hiiih level system ral^tit Jitst as well 
start ever, ' -' "■ " . " . 

Utien the procedural lev^l q«ts an error interrupt rron the dynamic, 
level, it could ■also- U5e either the clean sliate or patch tip cipproacb.' 
Halnly lie cause a- queue of DA£Vs does not really contain ttiat mijch 
infornati^n, the first approach is usually us«dr A hIioI? ni?w queue of 
DASV& ts cr&flted.' 

In Che initial arm control systers the. high level system will iise 

the clean slats approach. At a later dtite however, it ^ill be of great 

. '■ interest to inplement constructs that ivlll allow ths'hlgh level system 

- to talk with the procedural level alieut its intBriml state of e^cecutian.. 
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